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MODEL 4323 SERVO MOTOR CONTROLLER - STD 
MODEL 4333 SERVO MOTOR CONTROLLER - STD 
(1-2 AXES) 

FEATURES 

• 32-BIT DSP-BASED POSITION, VELOCITY, 
AND ACCELERATION REGISTERS 

• OPTIONAL SOFTWARE DRIVERS FOR 
LINEAR/CIRCULAR INTERPOLATION 
ELECTRONIC GEARING, & TUNING 

• SERVO UPDATE TIME OF 256 USEC AND 
REAL TIME INTERRUPTS 

• INPUTS FOR ONE INCREMENTAL 
ENCODER & THREE OPTO-ISOLATED 
EXTERNAL INTERRUPT INPUTS PER AXIS 

• 12-BIT ±10 VOLT OUTPUT (4323 ONLY) 
7-BIT PWM PLUS SIGN OUTPUT (4333 
ONLY) 

APPLICATIONS 

Motion control systems configured within an STD or 
STD32™ Bus structure can use the Models 4323 and 
4333 to control one or two DC servo motors without 
greatly increasing CPU overhead. Operations that re- 
quire precision servo control and positioning may be ac- 
commodated. 




DESCRIPTION 

Complex positioning and velocity profiling may be per- 
formed with the Model 4323 and 4333 Servo Motor Con- 
troller cards. Each card intelligently controls one or two 
DC servo motors. 

The cards use motion control ICs (DSP type) developed 
by National Semiconductor. These ICs offer position and 
velocity operating modes, with programmable velocity 
profiling. A set of 23 commands is used with the ICs. 
Commands may be executed on-the-fly. 

In the position operating mode, the host processor 
specifies acceleration, maximum velocity and final posi- 
tion. The motor will accelerate until the maximum 
velocity is reached or until the motor must begin the 
decelerate to stop at its final position. In the velocity 
mode, the motor accelerates to the command velocity 
and maintains that velocity until a new command is 
given. Trajectory parameters are 32-bit values. Accelera- 



tion and velocity each have 16 integral bits and 16 frac- 
tional bits. 

A digital Proportional-lntegral-Derivative (PID) filter is 
used to compensate the control loop. The filter proces- 
ses the position error, producing an output for the motor 
drive amplifier. Displacement from the desired position is 
opposed by an output that is proportional to the position 
error, the integral of the error, and the derivative of the 
error. 

The Model 4323 features a 12-bit D/A Converter. This 
converter produces a ±10 volt motor command. Model 
4333 provides sign and magnitude 7-bit Pulse-Width 
Modulated (PWM) output signals for directly driving 
switch-mode drive amplifiers. 

Each board provides inputs for feedback from two in- 
cremental encoders with quadrature output. Phase A, 
Phase B, and Index signals are accommodated. The 
Index line may be used to record the home position of 
the motor if it is not used by the encoder. Single-ended 
and differential encoders can be used. 

Three opto-isolated external inputs per axis go through 
polarity selection logic to an 82C59 programmable inter- 
rupt controller. In addition, two of the inputs may be set 
up as limits that cause their respective analog outputs to 
be grounded. 
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4323/4333 SOFTWARE 



Technology 80's software philosophy is to aid the programmer in the development of motion control applications while 
maintaining flexibility and high performance. Rather than defining a unique "high-level" motion language we provide a 
library of assembly routines (to reduce size and increase speed) that can be called from popular languages already 
used by the programmer. All the programmer has to do is to add an "include" statement to the source code and link 
with the proper library after compiling (or assembling). 

Languages supported: Microsoft C version 4.0 + , Microsoft Quick C version 2.0 + , Microsoft Quick Basic version 
4.0 + , Borland Turbo C version 2.0 + , Borland Turbo C+ + version 1 .0 + , Borland Turbo Pascal version 5.0 + , 
Microsoft Macro Assembler version 5.1 + , Borland Turbo Assembler version 2.0 + . 



#9004 Driver Package 

This is the base software package for the 4323/4333. The driver instruction set is listed below. Also included in this 
package is a Graphical luring Aid that displays encoder position as a function of time. Overshoot, undershoot and set- 
tling time are observable on the display. Tuning parameters may be adjusted via I 



INITIALIZATION ROUTINES 

INITSERVO Initializes the 4323 Software 

RESETAXIS Resets the given axis 

RESETALL Resets all the axes and all the boards 

LOW-LEVEL AXIS CONTROLLER ROUTINES 

TE4323_WR_CMD Writes a command byte to the given axis 

TE4323 WRWORD Writes a command byte and a data word (1 6 bits) to the given axis 
TE4323 WRJ.ONG Writes a command byte and a long word (32 bits) to the given axis 
TE4323 RDWORD Writes a command byte and reads a data word from the given axis 
TE4323 RD LONG Writes a command byte and reads a long word from the given axis 
TE4323 RDSTAT Reads the status port on the given axis 

TE4323 SERVO Writes a command byte and reads or writes data bytes to the given 

axis 

MOTION ROUTINES 



ABSPOS / RELPOS 

ABSVEL / RELVEL 
ABSACC / RELACC 

PROFILE 



START 
STOP MOVE 
ABORTMOVE 
COAST 
VELMODE 
HOME 

FILTER ROUTINES 

FILTER 
FILTERKP 
FILTERJO 
FILTER_KD 
FILTERJL 
FILTER_SI 
READJSUM 

DATA REPORTING 

ACTPOS 
DESPOS 
ACTVEL 
DESVEL 



Sends a new absolute or relative destination position to the given 
axis 

Sends a new absolute or relative command velocity to the given axis 
Sends a new absolute or relative command acceleration to the given 

axis 

Sends a new absolute motion profile, consisting of a destination 
position, command velocity, and command acceleration to the given 
axis 

Start the motion defined by one of the above motion routines 
Decelerates the given axis to a stop 
Stops the given axis as fast as possible 
Causes the motor to coast to a stop 

Runs the given axis In velocity mode at the specified velocity 
Defines the current position as zero 

Loads all the filter parameters to the given axis 
Loads the filter's proportional term 
Loads the filter's integral term 
Loads the filter's derivative term 
Loads the fitter's Integration limit 
Loads the filter's derivative sampling interval 
Reads the integration sum on the given axis 
ROUTINES 

Returns the axis' actual position 
Returns the axis' desired position 
Returns the axis' actual velocity 
Returns the axis' desired velocity 



INDEXPOS 
COMPLETE 



BREAKPT 



INDEX 
CMDERR 



WRAPAROUND 



READ SIGNALS 



Returns the axis' index position 

Returns "ACTIVE" If the axis' motion Is complete, otherwise 
returns "INACTIVE" 

Returns "ACTIVE" if the axis' breakpoint has been reached, 
otherwise returns "INACTIVE" 

Returns "ACTIVE" if the Index has occurred, otherwise returns 
"INACTIVE" 

Returns "ACTIVE" if a command error has occurred, otherwise 
returns "INACTIVE" 

Returns "ACTIVE" If a wraparound has occuned, otherwise 
returns "INACTIVE" 

Returns "ACTIVE" if an excessive position error has occurred, 

otherwise returns "INACTIVE" 

Reads the Signals Register from the given axis 



SERVO INTERRUPT ROUTINES 

SBPABS Sets an absolute breakpoint 

SPBREL Sets a relative breakpoint 

SINDEX Tells the axis to look for the next Index 

SERRI Sets the following-error limit, generating an Interrupt if the limit 

is exceeded 

SERRS Sets the following-error limit, causing the motor to coast and 

generating an interrupt if the limit Is exceeded 
MASKINT Masks an Interrupt on the axis controller 

UNMASKINT Unmasks an Interrupt on the axis controller 

RSTINT Resets and Interrupt on the axis controller 

READINTS Returns the active Interrupts from the axis controller 

MOTOR CONTROL AND LIMIT ROUTINES 
MOTOR_ON Enables the axis' motor output 

MOTOR_READ Returns "ACTIVE" if the axis' motor output is enables, otherwise 

returns "INACTIVE" 
UMIT READ Returns the state of the axis' limit inputs 

INTERRUPT ROUTINES 

INTJNIT Initializes the interrupt controller on the 4323 

INT DISABLE Disables the given interrupt source on the 4323 

INTENABLE Enables the given interrupt source on the 4323 

INT_POLL Returns which, if any, interrupt on the 4323 is active 

INT EOI Sends and "end of interrupt" command to the interrupt controller 

on the 4323 

ENABLEJRQ Enables the interrupt request output on the 4323 

DISABLE IRQ Disables the interrupt request output on the 4323 



#9006 Motion Coordination Drivers 

This set of software drivers consists of routines for linear/circular interpolation and electronic gearing/master-slave. Cir- 
cular interpolation describes the coordination of two independent motor axes to produce an apparent circular motion. 
The move will be performed at a user specified velocity, with arc center-point and ending-point entries describing the 
arc itself. An increment entry allows the user to indicate the angle step to calculate with, since all the interpolation math 
is accomplished "on-the-fly". The electronic gearing (master-slave) operation describes the tracking of one axis of mo- 
tion by another. The tracking (or slave axis) can be programmed to follow the motion of the master axis in either a 
velocity or position mode as required. The direction of rotation and tracking ratio (1 :65536) are also user variables. 

#9008 Servo System Simulation Software 

This software package is an "off-line" motion system simulator used by the designer to help define system components 
and check performance before running any actual hardware. The user enters information such as motor data, mechani- 
cal data, encoder resolution, gain and desired motion profile. The display indicates the velocity of the trajectory gener- 
ator (within the motion controller), velocity of the system, and following error. The emulation of the motion controller is 
based on the National Semiconductor LM628/629 ICs used on most Technology 80 servo controllers. System variables 
may be modified by the user to achieve optimum performance. The values obtained by the simulation may then be 
transferred to actual system components resulting in a high probability the system will perform as needed. 



CONNECTOR PIN ASSIGNMENTS: 



Front Plane Interrupts 


Encoder Inputs 
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Pin 


Description 


Pin 


Description 


1 


Ground 


1 


Phase A 


2 


InUi 
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3 


Ground 


3 


Ground 


4 


IRQ2 


4 


Phase A (DHf) or GND 


5 


Ground 


5 


Phase B (Diff) or GND 


6 


IRQ3 


6 


Index (Diff) or GND 


7 


Ground 


7 


Power (+5 or +12) 


8 


IRQ4 


8 


Phase B 


9 


Ground 


9 


Power ( + 5 or +12) 


10 


IRQ5 


10 


Index 



LIMIT INPUTS (J5) 


Pin 


Description 


Pin 


Description 


1 


+5 




9 


+ 5 


2 


Ground 




10 


Ground 


3 


Axis B Home + 




11 


Axis A Home + 


4 


Axis B Home - 




12 


Axis A Home - 


5 


Axis B Limit 1 + 




13 


Axis A Limit 1 + 


6 


Axis B Limit 1- 




14 


Axis A Limit 1- 


7 


Axis B Limit 2 + 




15 


Axis A Limit 2 + 


8 


Axis B Limit 2- 




16 


Axis A Limit 2- 



MOTOR DRIVE OUTPUTS (J1) 


Pin 


Description 


Pin 


Description 


1 


Axis B (Not Used) 


8 


Axis A (Not Used) 


2 


Axis B PWM Sign 


9 


Axis A PWM Sign 


3 


Axis B PWM Pulse 


10 


Axis A PWM Pulse 


4 


Axis B Opto +5 Input 


11 


Axis A Opto +5 Input 


5 


Axis B Opto Ground 


12 


Axis A Opto Ground 


6 


Axis B Analog Output 


13 


Axis A Analog Output 


7 


Analog Ground 


14 


Analog Ground 



MODEL 4323 SERVO MOTOR CONTROLLER - STD 
MODEL 4333 SERVO MOTOR CONTROLLER - STD 



SPECIFICATIONS 



SYSTEM COMPATIBILITY 

STD Bus, STD32™, 82C59 Interrupt Controller, 
Cascaded interrupts are supported. 



ENCODER COMPATIBILITY 

Quadrature type incremental encoders with 
a maximum encoder input rate of 1 MHz. 
Open collector or totem pole drivers, single- 
ended or differential inputs. 



CARD DIMENSIONS 

4.5" x 6.5" x 0.6" 



OPERATING RANGE 

0° to 70° C 



VOLTAGE REQUIREMENTS 

STD Bus: +5V @ .5A (typical) 

1.1 A (maximum) 

+ 12V @ 30mA (typical) 

70mA (maximum) 
-12V @ 50mA (typical) 
90mA (maximum) 

MATING CONNECTORS 

10-Pin Headers (J2, J3, J4) 

Digi-Key CKC1 0T-ND 
Digi-Key CKR10T-ND 

16-Pin Header (J5) 

Digi-Key CKC16T-ND 
Digi-Key CKR16T-ND 

14-Pin Header (J1) 

Digi-Key CKC14T-ND 
Digi-Key CKR14T-ND 




rtDncDlk „ ^ Model 4323/4333 Block Diagram 

ORDERING INFORMATION: 

Model 4323-1 Servo Motor Controller - Analog Output (1 Axis) 
Model 4323-2 Servo Motor Controller - Analog Output (2 Axes) 
Model 4333-1 Servo Motor Controller - PWM Output (1 Axis) 
Model 4333-2 Servo Motor Controller - PWM Output (2 Axes) 
Also See: 9004 Software Drivers 

9006 Application Software Drivers 

System Design Aids 

6400 Series of Servo Motor Amplifiers 

Warranty: Technology 80 Inc. provides a limited 2 year warranty on all of its STD Bus-based products, in accordance with its warranty policy. 

Note: The information in this publication has been carefully checked and is believed to be reliable; however, no responsibility is assumed for possible inaccuracies or omissions. 
STD32 is a registered trademark of Ziatech Corporation, San Luis Obispo, California 

© 1992 Technology 80, Inc. 



